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Abstract 
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1 Introduction 



This work is devoted to the study of the left-invariant sub-Riemannian problem 
on the group of motions of a plane. This problem can be stated as follows: given 
two unit vectors uo = (cos j sin (?o ) > ^^i = (cos 0i, sin ^i) attached respectively 
at two given points (xo,j/o)i {^IjVi) in the plane, one should find an optimal 
motion in the plane that transfers the vector uq to the vector vi, see Fig. 1. The 
vector can move forward or backward and rotate simultaneously. The required 
motion should be optimal in the sense of minimal length in the space {x,y,6), 
where 9 is the slope of the moving vector. 



y 




Figure 1: Problem statement 



The corresponding optimal control problem reads as follows: 

i; = uicos^, y = 'Uisin^, = U2, (1.1) 

q={x,y,e)eM^RlyXSl w=(ul,U2)eR^ (1.2) 

9(0) = (?o = (0,0,0), q{ti)=qi = {xuyi,Oi), (1.3) 

1 = J ^Jul + uldt^ min, (1.4) 
or, equivalent ly. 
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tl 



J = - (ttf + U2) dt min . (1.5) 
2 Jo 

This work is an immediate continuation of the previous work [8]. We use 
extensively the results obtained in that paper, and now we recall the most 
important of them. 

Problem (1.1)-(1.5) is a left-invariant sub-Riemannian problem on the group 
of motions of a plane SE(2) = k S0(2). The normal Hamiltonian system 
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of Pontryagin Maximum Principle becomes triangular in appropriate coordi- 
nates on cotangent bundle T*M, and its vertical subsystem is the equation of 
mathematical pendulum: 

7 = c, c=-sin7, (7, c) G C (25I) X K,, (1.6) 
i = sin — COS0, y = sin — sin 9 — —cos—. 0--'^) 

In elliptic coordinates {(p,k), where (p is the phase, and k a rcparamctrized 
energy of pendulum (1.6), the system (1.6), (1.7) was integrated in Jacobi's 
functions [19]. The equation of pendulum (1.6) has a discrete group of symme- 
tries G = {Id, e^, . . . , e^} = Z2 x Z2 x Z2 generated by reflections in the axes of 
coordinates 7, c, and translations (7, c) (7 -|- 2tt, c). Action of the group G is 
naturally extended to extremal trajectories {xt, yt), this action modulo rotations 
is represented at Figs. 2-4. 



Figure 2: Action of Figure 3: Action of Figure 4: Action of 

e\ £^ on {xt,yt) e"^, e'^ on {xt,yt) , on {xt,yt) 

Reflections are symmetries of the exponential mapping Exp : N = C x 
M+ M, Exp(A,t) = Qf 

The main result of work [8] is an upper bound on cut time 

tout = sup{ii > \ Qs is optimal for s G [0,ii]} 

along extremal trajectories g^. It is based on the fact that a sub-Riemannian 
geodesic cannot be optimal after a Maxwell point, i.e., a point where two distinct 
geodesies of equal sub-Riemannian length meet one another. A natural idea is to 
look for Maxwell points corresponding to discrete symmetries of the exponential 
mapping. For each extremal trajectory Qs = Exp(A,s), we described Maxwell 
times t" (A), i = 1, . . . , 7, n = 1,2,..., corresponding to discrete symmetries e*. 
The following upper bound is the main result of work [8]; 

icut(A) < t(A), A G C, (1.8) 

where t(A) = min(t^i(X)) is the flrst Maxwell time corresponding to the group 
of symmetries G. We recall the explicit definition of the function t(A) below in 
Eqs. (3.3)-(3.7). 

In this work we obtain a complete solution to problem (1.1)-(1.5). 
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First wc study the local optimality of sub-Ricniannian geodesies (Section 2) . 
We show that extremal trajectories corresponding to oscillating pendulum (1.6) 
do not have conjugate points, thus they are locally optimal forever. In the case 
of rotating pendulum we prove that the first conjugate time is bounded from 
below and from above by the first Maxwell times and t-^a respectively. For 
critical values of energy of the pendulum, there are no conjugate points. 

In Sections 3 5 we study the global optimality of geodesies. We construct 
decompositions of the preimage and image of exponential mapping into smooth 
stratas of dimensions 0, . . . , 3 and prove that the exponential mapping trans- 
forms these stratas diffeomorphically. As a consequence, we show that inequal- 
ity (1.8) is in fact an equality. Further, we describe explicitly the Maxwell strata 
and cut locus in the problem. For some special terminal points qi, we provide 
explicit optimal solutions. Finally, we present plots of the conjugate and cut 
loci, and of sub-Riemannian spheres. 

2 Conjugate points 

In this section we obtain bounds on conjugate time in the sub-Riemannian 
problem on SE(2), see Th. 2.6. 

2.1 General facts 

First we recall some known facts from the theory of conjugate points in optimal 
control problems. For details see, e.g., [2,3,17]. 

Consider an optimal control problem of the form 



where M is a finite-dimensional analytic manifold, /(q, u) and ip{q, u) wee respec- 
tively analytic in (q, u) families of vector fields and functions on M depending 
on the control parameter u d U, and U an open subset of M™. Admissible con- 
trols are u(-) e L^{[0,ti],U), and admissible trajectories g(-) are Lipschitzian. 
Let 

K{X) = {\J{q,u))-^{q,u), \eT*M, q^n{\)eM, u e U, 

be the normal Hamiltonian of PMP for the problem (2.1)^(2.3). Fix a triple 
{u{t), Xt,q{t)) consisting of a normal extremal control u{t), the corresponding 
extremal A/, and the extremal trajectory q{t) for the problem (2.1)-(2.3). 
Let the following hypotheses hold: 

(HI) For all A e T*M and u & U , the quadratic form ^ ^ (A) is negative 
definite. 



9(0) = go, 



qeM, u e C/ C M", 
q{ti) = qi, ti fixed, 



(2.1) 
(2.2) 




(2.3) 
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(H2) For any A e T*M, the function u i— > hu{X), u G U, has a maximum point 
u{X) G U: 

hu(X){X) = max/i„(A), A e T*M. 

(H3) The extremal control u{-) is a corank one critical point of the endpoint 
mapping. 

(H4) All trajectories of the Hamiltonian vector field H{X), A e T*M, are con- 
tinued for t € [0, +00) . 

An instant > is called a conjugate time (for the initial instant t = Q) 
along the extremal At if the restriction of the second variation of the endpoint 
mapping to the kernel of its first variation is degenerate, sec [3] for details. In 
this case the point = 7r(At,) is called conjugate for the initial point go 

along the extremal trajectory g(-). 

Under hypotheses (HI) -(H4) , we have the following: 

1. Normal extremal trajectories lose their local optimality (both strong and 
weak) at the first conjugate point, see [3]. 

2. An instant t > is a conjugate time iff the exponential mapping Expj = 

TT o e*^ is degenerate, sec [2]. 

3. Along each normal extremal trajectory, conjugate times are isolated one 
from another, see [17]. 

We will apply the following statement for the proof of absence of conjugate 
points via homotopy. 

Proposition 2.1 (Corollaries 2.2, 2.3 [16]). Let {u''{t),Xf), t e [0,+oo), s G 
[0,1], be a continuous in parameter s family of normal extremal pairs in the 
optimal control problem (2.1) -(2.3) satisfying hypotheses (HI) -(H4) . 

(1) Let s I— > tf be a continuous function, s G [0,1], tf G (0,+oo). Assume 
that for any s G [0, 1] the instant t = tl is not a conjugate time along the 
extremal Xf. 

Lf the extremal trajectory q^{t) = 7r(At), t G (0,^°], does not contain con- 
jugate points, then the extremal trajectory q^{t) = 7r{Xl), t G {0,tl], also 
does not contain conjugate points. 

(2) Let for any s G [0, 1] and T > the extremal Af have no conjugate points 
for t G (0, T]. Then for any T > 0, the extremal X\ also has no conjugate 
points fort G (0,T]. 

One easily checks that the sub-Ricmannian problem (1.1)-(1.5) satisfies all 
hypotheses (HI) -(H4) , so the results cited in this subsection are applicable 
to this problem. 

We denote the first conjugate time along an extremal trajectory q{t) = 
Exp(A,i) asC"'(A)- 
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2.2 Conjugate points for the case of oscillating pendulum 

In this subsection wc assume that A G Ci and prove that the corresponding 
extremal trajectories do not contain conjugate points, see Th. 2.1. 

Using the parametrization of extremal trajectories obtained in Subsec. 3.3 [8] , 
we compute explicitly Jacobian of the exponential mapping: 

J ^ dixuVuPt) ^ 4 

d{t,ip,k) k^{l — k'^){l — k'^ sn"^ p sii^ t) ' 
p = t/2, + (2.4) 

Jl (t, p, k) ~ vi sv? T + V2 cn^ t , (2-5) 
vi = {l-e){p- E(p))(E(p) -{l-e)p), 

V2 = {p- E{p) ) ( E{p) - (1 - + k^ cnp dnp (2 E{p) + (fc^ - 2)p) snp 
+ A;2((E(p) -p)(E(p) -{l-k'^)p)-k^)sn^p +k^sn^p, 

so that sgn J = sgn Ji. 

2.2.1 Preliminary lemmas 

Lemma 2.1. For any k G (0, 1) and p > we have Vi{p, k) > 0. 
Proof. The statement follows from the relations 

p-E{p)=k'^l sn^tdt>0, E(p) -(l-fc^)p = fcM cn^ i rft > 0. (2.6) 
Jo Jo 

□ 

Lemma 2.2. For any k e (0, 1), n e N, and t e ]R we have Ji(t, 2Kn, k) > 0. 

Proof. If p = 2Kn, n e N, then V2{p,k) = (p- E(p) )(E(p) - (1 - k'^)p) > by 
inequahties (2.6). 

By virtue of Lemma 2.1 and decomposition (2.5), we obtain the inequality 
Ji{T,2Kn,k) >0. □ 

Lemma 2.3. V pi > 3 fc e (0, 1) V fc e (0,fc) Vp e (0,pi) Vr e K 

Ji{T,p,k) > 0. 

Proof. The statement of the lemma follows from the Taylor expansions: 

Ji = ^(V-sin2 2p) + o(fc*), fc^O, (2.7) 
Ji = ifcV + o(fc'+p')', fc'+p'^O. (2.8) 

By contradiction, if the statement is not verified, then there exists a converging 
sequence (r„,p„,A;„) (ro,_po,0) such that J{Tn,Pn,kn) < for all n G N. If 
Pq > 0, then a standard calcuhis argument yields contradiction with (2.7). And 
if po = 0, then similarly one obtains a contradiction with (2.8). □ 



8 



2.2.2 Absence of conjugate points in Ci 

Theorem 2.1. If \ ^ Ci, then the extremal trajectory q{t) = Exp(A,f), t > 0, 

does not contain conjugate points. 

Proof. We choose any A S Ci, t > 0, and prove that the extremal trajectory 
q{t) = Exp(A, t) does not contain conjugate points for t G {0,t]. 

Find the elliptic coordinates (fc, (p) corresponding to the covcctor A G Ci 
according to Subsec. 3.2 [8], and let p = t/2, r = if + p. Find n G N such that 
pi — 2K{k)n > p. Choose the following continuous curve in the plane {k,p): 

I s e [0,1]}, k'^sk, p' = 2K{k')n, 

with the endpoints = (0,7rn) and {k^,p^) = {k,2K{k)n). 

Consider the following family of extremal trajectories: 

7^ = {q'{t) = Exp(^^A;^^) \te[Q,t']}, sG [0,1], 
t' = 2p', ip' = T-p'. 

The endpoint q^{t^) of each trajectory 7'', s E [0,1], corresponds to the 
values of parameters {T,p,k) = {T,2K{k'^)n, k'^). Thus Lemma 2.2 implies that 
for any s G [0, 1] the endpoint is not a conjugate point. 

Further, Lemma 2.3 states that 

3fcoe(0,fc) VreR Vpe(0,pi) J{T,p,k)>0. (2.9) 

Denote sq = ko/k G (0,1), so that = ko- Condition (2.9) means that the 
extremal trajectory 7*" docs not contain conjugate points for all t G [0,t*"]. 

Then Proposition 2.1 yields that for any s G [sq, 1], the extremal trajectory 
q^{t) does not contain conjugate points for all t G [0,t^]. In particular, the 
trajectory q{t) = q^(t), t G {0,t\, is free of conjugate points. □ 

So we proved that extremal trajectories q(t) = Exp(A, t) with A G Ci (i.e., 
corresponding to oscillating pendulum) are locally optimal at any segment [0, ti], 
ti > 0. 

2.3 Conjugate points for the case of rotating pendulum 

In this subsection we obtain bounds on conjugate points in the case A G C2. 
Using the formulas for extremal trajectories of Subsec. 3.3 [8], we get: 



d{xt,yt,9t) ^ 4fc 

d{t,ip,k) (l-A;2)(l-fc2sn2psn2r) ^' 

p = t/{2k), T = i} + t/{2k) = {2^ + t)/{2k), (2.10) 

J2 = asn^T +/JcnV, (2.11) 

a = (1 - fc^)snpai, (2.12) 

ai = cnp dnp(p- 2E(p) ) + snp{dT?p + E(p) (p - E(p))), (2.13) 

= /i(p)/3i, A = cnp E(p) - dnp snp , (2.14) 
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where fi{p,k) = cnp(E(p) — p) — dnp snp, see Eq. (5.12) [8]. 
2.3.1 PreliminEiry lemiriEis 

Recall that we denoted the first positive root of the function fi{p) by see 
Lemma 5.3 [8]. 

Lemma 2.4. If k G (0, 1) and p = Pi{k), then a{p, k) > 0. 
// additionally snr ^0, then J2 > and J < 0. 

Proof. In terms of the auxiliary function 

<fi{p,k) = snp dnp — (2E(p) —p)cnp, (2.15) 
we have a decomposition 

ai = diipip{p) + sup E(p) {p — E(p) ). (2-16) 

Let k G (0, 1) and p = p\{k). Then fi{p) = 0, i.e., sup dnp = cup (E(p) — 
p). Thus ip{p) = ciip{'E{p) — p) — (2E(p) —p)ciip = — Yj{p) cup. By virtue 
of Cor. 5.1 [8], we have cnp < 0, so (p{p) > 0. Moreover, snp > 0. Then 
decomposition (2.16) yields ai{p) > 0, consequently, a{p) > 0. 

If additionally snr ^0, then it is obvious that J2 > and J < 0. □ 

Lemma 2.5. 3 fc e (0, 1) V fc € (0,fc) Vpe(0,p}] a{p,k)>0. 

Proof. The statement of this lemma follows by the argument used in the proof 
of Lemma 2.3 from the Taylor expansions 

a = sinp(sinp — pcosp) + o(l), k 0, 

a = P^ + o{p^ + k^f, p^ + k'^0. 

□ 

Lemma 2.6. V fc e (0, 1) Vp e (0, 2K] l3i{p, k) < 0. 

Proof. Since (/3i(p)/cnp)' = —(1 — fc^) sn^p/cn^p , the function /3i(p)/cnp 
decreases at the segments p e [0, K) and p e (if, 2iir]. 

We have /3i(0) = 0, thus /3i(p)/cnp < 0, so /?i(p) < for p e {Q,K). 

Further, /3i(is:) = -Vl - fc^ < 0. 

Since /3i(p)/cnp +00 as p ^ + 0, and ^1 (2/4') / cn(2ii') = E(2ii') > 0, 
we have /3i(p)/cnp > 0, so /3i(p) < for p e {K,2K]. □ 

Lemma 2.7. Xe< k e (0, 1). 

(1) Let snr =0. T/ien J2{T,P,k) > /orp € (0,pj), and J2(r,p, fc) = /or 

p^pI- 

(2) Lei snr ^0. Then J2(r,p, k) > for p e {0,p\]. 
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Proof. Ifp e {0,p\), then /i(p, k) < (Cor. 5.1 [8]), and pi{p, k) <0 (Lemma 2.6), 
thus P{p, k) = flip, k)Pi{p, k) > 0. 

(1) Let snr =0. Ifpe (0,pj), then J2(t,p, fc) = 0{p,k) > 0. Andifp = pJ, 
then fi{p, k) = 0, thus J2(r,p, k) = (3{p, k) = 0. 

(2) Let snr 7^ 0. 

(2. a) We prove that the function ip{p) given by (2.15) satisfies the inequality 

ip{p)>Q \/pe{Q,K]. 

First, ip{p) = + o{p^) > as p ^ +0. Second, 

((^(p)/cnp)' = dn^ p sn^ p / cn^ jj >0 Vpe(0,ii'). 

Thus (;9(p) > for p e (0, K). And if p = if, then ip{p) = Vl - k'^ > 0. 

(2.b) By virtue of the decomposition (f{p) = —fi{p) — E(p) cnp, we get the 
inequality (p{p) > for all p G {K,pl]. Wo proved that 

^{p)>o ypG{o,pl]. 

(2.c) In view of (2.16), we obtain that ai{p) > for p G (OjPi]- Then 
Eq. (2.12) yields a{p) > for p G (0,p}]. Finally Eq. (2.11) gives J2 > for 
pe{0,p\]. □ 

Lemma 2.8. V ^ G (0, 1] 3 fc G (0, 1) V A; G (0,A:) V p G (0,p}] we have 
J2{z,p,k) > 0. 

Proof. Fix any 2; G (0, 1]. By Lemma 2.5, 

3fcG(0,l) VfcG(0,fc) ype{0,p\] a{p,k)>0. 

But if p G {0,p\], thenp G {0,2K], thus Pi{p,k) < by Lemma 2.6, so /3(p,fc) > 
by Cor. 5.1 [8]. 

Then the inequalities a{p, k) > 0, (3{p, k) > imply the required inequality 
J2{T,p,k)>0. □ 



2.3.2 Conjugate points in C2 

First wc obtain a lower bound on the first conjugate time. It will play a crucial 
role in the subsequent analysis of the global structure of the exponential mapping 

in Sections 3, 4. 

Theorem 2.2. //A G C2, then f°''\X) > 2fcp}(fc). 

Proof. Given any A G C2, compute the corresponding elliptic coordinates (1^, k). 
If additionally we have t > 0, find the corresponding parameters p = t/{2k), 
T = ip/k + t/{2k) and denote z = sn^ r . 

We should prove that for any A G C2 the interval t G (0,2fcp}(A;)) does not 
contain conjugate times for the extremal trajectory q{t) = Exp(A,t). 
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Take any A"'^ € C2 and denote the corresponding elliptic coordinates {cp^, k^). 
For = 2k^p\{k^) we denote the corresponding parameters p^, r^, z^. In order 
to prove that the extremal trajectory q^{t) = Exp(A^, does not have conjugate 
points at the interval t G {0,t^), we show that 

pe(0,p^) J2{z^,p,k^)>0 J{z^,p,k^) <0. 

(1) Assume first that z^ = sn^{T^,k^) ^ 0, i.e., z^ € (0, 1]. We prove that in 
this case 

pe{o,p'] => J{z\p,k')<o. 

Consider the following continuous curve in the space {z,p,k): 
{{z\p',k')\s G{0,1]}, k' = sk\ p'=pl{k'). 
The corresponding curve in the space (r, p, k) is 

{(r^p^ k')\s& (0, 1]}, t" = F{&m{T\k'),k'), 
and in the space {t, ^, k) is 

{(^^^^fc«) |se(o,i]}, t^ = 2¥p\ v^ = {T^-p^)k\ 

Let A* = (i^**, k"), s G (0, 1], be the corresponding curve in C2, and consider the 
continuous one-parameter family of extremal trajectories 

=Exp(A^^), t€[0,t'], se(0,l]. 

Foranyse (0, 1], if t = i*, then by Lemma 2.4 we have J2(^^,p}(fc''), A:'^) < 0, 
i.e., the terminal instant t = \s not a conjugate time along the extremal 
trajectory q'^{t). 

Further, by Lemma 2.8, for z^ e (0, 1] 

3 fee (0,1) Vfce(o,fc) Vpe (o,p}(A;)] J2(^\p,fc) > 0. 

Consequently, there exists so G (0,1) such that the whole trajectory q^°{t), 
t e (0,f*°], is free of conjugate points. 

Then Propos. 2.1 implies that the trajectory q^{t), t G {0,t^], also does not 
contain conjugate points. 

We proved that if z^ ^ 0, then the trajectory q^{t) = Exp(A^,t), t G {0,t^], 
does not have conjugate points. 

(2) Now consider the case z^ = sn^(T^, k^) = 0. Then Lemma 2.7 states that 
the terminal instant t = 2k^p\{k^) is a conjugate point. We prove that all the 
less instants are not conjugate. 

Since conjugate points are isolated one from another at each extremal tra- 
jectory, there exists p < pl{k^) arbitrarily close to Pi{k^) such that the corre- 
sponding time t = 2k^p is not conjugate. 
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Consider the continuous curve in the space {z,p, k): 

{{zs,p,k^) \ s e[0,s)}, Zs = sz^. 

By item (1) of this proof, there exists £ > such that for any s e (0,e) the 
extremal trajectory q''{t), t G (0,^"], = 2k^p, does not have conjugate points. 
By Propos. 2.1, for s = the initial extremal trajectory q'^{t), t e (0,t°], also 
does not contain conjugate points. The endpoint = 2k^p can be chosen 
arbitrarily close to = 2k'^p\{k^), so the initial extremal trajectory does not 
have conjugate points for t £ {Q,t^). □ 

Now we obtain the final result on the first conjugate time in the domain C2 

— the following two-side bound. 

Theorem 2.3. //AG C2, then 

2kp\{k) < tJ°"j(A) < 4kK{k). (2.17) 

Proof. We proved in Th. 2.2 that 2kpl{k) < tl°''\X); moreover, if t e (0,2fcpJ), 
then J < 0. 

Let t = AkK, then p = 2K, thus a = 0, /i = p- E(p) > 0, /3i = - E(p) < 0, 

so 

Ak Ak 
J = -13^2 ^2 = cn^ r E(p) (p - E(p) ) > 0. 

It follows that for any A G C2 the function t ^ J has a root at the segment 
t G [2kp\AkK]. Consequently, also the first root f^""^ G [2kp\,AkK]. □ 

One can show that the bound (2.17) can be a little bit improved. The precise 
bound on the first conjugate time is 

2kp\{k) < t^°"j(A) < j{k) = mm{'lkK,2kp'^'{k)), (2.18) 

where p = p'^^(k) is the first positive root of the equation ai(p) = 0, and 
the function ai is given by Eq. (2.13). One can show that j{k) = AkK for 
k G (0, fco] and 7(fc) = 2fcp"^(fc) for [fco, 1), where fco ~ 0.909 is the unique root 
of the equation 2E{k)—K{k) = 0, see Proposition 11.5 [15]. Thus for k G (fco, 1) 
the bound (2.17) is not exact and can be replaced by the following exact one: 

2kp\{k)<t'^''\\)<2kp'^^{k), fcG(fco,l). (2.19) 

The bound (2.17) is illustrated at Figs. 5, 6; and the bound (2.19) — at Fig. 7. 
The exact bounds (2.18) are plotted at Fig. 8. 

Proposition 2.2. Let A G C2 and t = {2(p + 2kp\)/{2k). 

(1) If snr = 0, then f^''\\) = 2fcpJ. 

(2) // snr ^ 0, then t'i°'^^{\) G {2kpl,AkK]. 
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Figure 5: Plot of ti°"j(V',fc), k = Figure 6: Plot oi tl""' {i/j , k) , k = ko 

0.8 < ko 



t t 




Figure 7: Plot of ti°"j(V', fc), k = Figure 8: Bounds of tl""' {tp , k) 

0.99 > ko 
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Proof. Notice first that by Th. 2.2, the interval {0,2kp\) does not contain con- 
jugate times. Then items (1), (2) of this proposition follow directly from the 
corresponding items of Lemma 2.7, and from Th. 2.3. □ 

Now we apply Proposition 2.2 to fill the gap appearing in Th. 5.3 [8]. 

Theorem 2.4. There holds the bound 

icut(A) < t(A) V A e C. (2.20) 

Proof. If A e C \ C2 or (A,t) e N2, p = p\{k), snr ^ 0, then Th. 5.3 [8] gives 
the required bound. And if {X,t) € N2, p = p\{k), snr =0, then the bound 
is provided by Proposition 2.2 since tcut(A) < ti°'^''(A) (local optimality is lost 
after or simultaneously with the global optimality). □ 

2.4 Conjugate points for the cases of critical energy of 
pendulum 

The subset C3 U C4 U C5 of the cylinder C is the boundary of the domain Ci, 

sec Fig. 2 [8]. Thus absence of conjugate points for the corresponding extremal 

trajectories follows by limit passage from Ci. 

Theorem 2.5. // A e C3 U C4 U C5, then the corresponding extremal trajectory 
q{t) = Exp(A, t) does not have conjugate points for t > 0. 

Proof. For any A € C3 U C4 U C5, there exists a continuous curve A", s £ [0, 1], 
such that A* G Ci for s G [0, 1) and A^ = A. By Theorem 2.1, the trajectories 
g*(i) = Exp(A'', f), t > 0, are free of conjugate points. Then Propos. 2.1 implies 
the same for the trajectory q^{t) = q{t). □ 

2.5 General bound of conjugate points 

We collect the bounds on the first conjugate time obtained in the previous 
subsections. 

Theorem 2.6. (1) // A e Ci U C3 U C4 U C5, then tl°''\X) = +00. 

(2) IfXe C2, then tl°'^^{X) e [2kpl,AkK]. 

(3) Consequently, ti°"j(A) > t(A) for all A e C. 

3 Exponential mapping of open stratas and cut 
time 

In this section we prove that tcut(A) = t(A) for any X G C and describe the 
optimal synthesis on an open dense subset of the state space. 
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3.1 Decompositions in preimage and image of exponential 
mapping 

Denote M = M \ {qq}. For any point q € M there exists an optimal trajeetory 
g(s) = Exp(A, s) sueh that q{t) = q, (A, t) G N. Thus the mapping Exp : TV 
M is surjective. By Th. 5.4 [8], the optimal instant t satisfies the inequality 
t <t{X). So the restriction 

Exp : N ^M, 
N={{X,t) GN\t<t{X)}, 

is surjective as well. 

3.1.1 Decomposition in N 

Now we select open dense subsets of A'^ such that restriction of Exp to these 
subsets will turn out to be a diffeomorphism. Let 

N = {(A,t) € uf^iN, I t < t(A), snr cnr ^ 0}, (3.1) 
N' = {{X,t) G uf^iiVj I t = t(A) or snr cnr = 0} UiV4 U A^s, 
iV4 = iVn A^4. 

We have the obvious decomposition ISf = N Li N' (we denote by U the union of 
mutually non- intersecting sets). 

There hold the following implications, see [8] : 

{X,t)GNi ^ t{X) = 2K, TeR/{4KZ), 
{X,t)GN2 ^ t{X) = 2kp\, T GR/i'iKZ), 
{X,t) e TVs t(A) = +0O, T e M. 

Consequently, there holds the following decomposition: 

TV^utiA, 

where the sets i = 1, . . . , 8, are defined by Table 1. 

Table 1 should be read by columns. For example, the first column means 
that 

Di = {Di n Ni) u (£>i n N2) u {Di n Ns), 

£>i niVi = {{T,p,k) e JVi I A e C?, T e {3K,4K), p e {o,K), k e (o,i)}, 
DinN2 = {{t,p, fc) e JV2 1 a e C+, r e (-/^,o), p e (0,^1), k e (0, i)}, 
£>inTV3 = {(T,p,fc)eiV3|AeC^+, re (-00,0), pe(o,+oo), A; = i}. 

Projections of the sets Di to the phase cylinder of the pendulum (7, c) are 
shown at Fig. 9. 
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Table 1: Definition of domains Ds 



c 





Di 


D2 


D5 


De 






— TT 

D4 




D3 


TT 


Dr 





Figure 9: Projections of domains Di to the phase cylin- 
der of pendulum (25^) x 
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Lemma 3.1. Each set Di, i = 1, . . . ,8, is homeomorphic to M^. 

Proof. We prove the statement only for the set D2 since all other sets Di can 
be defined in the coordinates (r, p, k) by the same inequalities as D-2 by a shift 
of origin in elliptic coordinate ip. Taking into account Table 1 and Eqs. (2.4), 
(2.10), we get: 

D2 = (£>2 n ATi) u {D2 n N2) u {D2 n N^), 

£)2niVi = {(A,t) eTVi I AeC?, fce(o,i), t€{Q,2K), <p g {-t,-t + 2K)}, 

D2nN2 = {iX,t)GNi\XGC}, fee (0,1), t€{0,2kpl), ip G {-t,-t + 2kK)}, 

DsniVa = {(A,t) e TVi I A e C^+, fc = 1, i e (o,+oo), if e (-t,+oo)}. 

As shown in [15], one can choose regular system of coordinates {ki,(p,t) on 
the set D2, where 

fci = fc for A e Ci; ki = 1/k for A e C2; fci = 1 for A e C3. 

In this system of coordinates 

D2 = {z/ = (A:i,(/?,t) I ki e (0,+oo), i G (0,ii(fci), e (-t, -t + ^2(^2))}, 

(3.2) 

where ti(fci) = 2i\:(fci) for ki € (0,1), ti(fci) = +00 for ki = 1, ti(fci) = 
(2/A:i)pi(l/fci) for fci G (1,+(X)); and f2(fci) = 2K{ki) for fci G (0,1), t2{ki) = 
+00 for fci = 1, t2iki) = {2/ki)K{l/ki) for fci e (l,+oo). The both functions 
ti : (0, +00) (0,+oo], i = 1,2, are continuous. Thus representation (3.2) 
implies that the domain D2 is homeomorphic to M"^. □ 

Consequently, all domains Di are open, connected, and simply connected. 
These domains are schematically represented in the left-hand side of Fig. 10. 

3.1.2 Decomposition in M 

The state space of the problem admits a decomposition of the form 
M = MUM', 

M = {qeM\ Ri{q)R2{q) sin ^ 0}, 
M' = {q&M\ Ri{q)R2{q) sin 6* = 0}, 

where 

^ ■ ^ T. 0.6 

Ri = y cos a; sin - , R2 = x cos - + « sm - . 

^ 2 2 2 2 

Further, 

M = utiM„ 

where each of the sets Mj is characterized by constant signs of the functions 
sin^, Ri, R2 described in Table 2. 
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Table 2: Definition of domains Mj 



For example, Mi = {g' e M | sin^ < 0, i?i > 0, R2 > 0}. The numeration 
of the sets Mi is chosen so that it correspond to numeration of the sets Ni (we 
prove below in Th. 3.1 that each mapping Exp ; iVj Mi is a diffeomorphism) . 
It is obvious that all the sets are diffeomorphic to M^. 

All the domains Mi are contained in the set {q G M \ 6 0}. At this set 
is a single-valued function, and we choose the branch 9 G (0,27r). Thus in 
the sequel we assume that 6 G (0,27r) on the sets Mj. Then i?2 become 
single- valued functions, and the last two rows of Table 2 reflect the signs of these 
single- valued functions Ri on the sets _Mi. 

The boundary M' of the domain M decomposes into four mutually orthog- 
onal surfaces: two planes {9 = 0}, {9 = tt} and two Moebius strips {Ri = 0}, 
{R2 = 0}, see the right-hand side of Fig. 10, and Fig. 7 [8]. 

3.2 Diffeomorphic properties of exponential mapping 

Lemma 3.2. For any i = 1, . . . ,8, we have Exp(£)j) c Mj. 

Proof. We prove only the inclusion Exp(Z)i) C Mi since the rest inclusions are 
proved similarly. 

Let (A,t) e L>iniVi = {(A,i) G iVi | A e C?, r G {5K,AK), pe (0,X), fc G 
(0,1)}, see Table 1. Since A G C^, then ,si = sgn(7t/2) = 1. Moreover, 
cnp snp dnr > 0, thus sin 6*4 < by virtue of Eq. (5.2) [8]. So 9t/2 G {n/2,7r). 
Consequently, cos{9t/2) < 0, sin 6*4/2 > on Di n Ni, thus S3 = —1, 54 = 1 in 
Eq. (5.3)-(5.6) [8]. Then we get i?i > from Eq. (5.5) [8], and R2 > from 
Eq. (5.6) [8] and Lemma 5.2 [8]. We proved that if 1/ G Z^i n TVi, then sin 9^ < 0, 
Ri > 0, i?2 > 0, i.e., Exp(i/) G Mi, see Table 2. That is, Exp(Di n Ni) c Mi. 

Since the domains Di and Mi are connected, it follows that Exp(Z)i) c 
Ml. □ 

Lemma 3.3. The restriction Exp|j^ is nondegenerate. 

Proof, liv = (A,t) G N, then t < t(A). By Th. 2.6, ^^""^(A) > t(A), thus t < 
t^°"^(A) = inf{s > I Exp(A,s) is degenerate }. Consequently, the exponential 
mapping is nondegenerate at the point (A,t). □ 

Lemma 3.4. For any i = 1, . . . , 8. the mapping Exp : Di — s- Mi is proper. 

Proof. Similarly to Lemma 3.1, we can consider only the case i = 2. Let K C M2 
be a compact, we show that S = Exp~^[K) c £'2 is a compact as well, i.e., S 
is bounded and closed. 
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There exists £ > such that 

|siii^|>e, e<\Ri\,\R2\<l/e for all g e i^. 

(1) Wc show that S is bounded. By contradiction, let z/„ = (fc„, (^„, i„) — > oo 
for some sequence C S. Then there exists a sequence C S (1 Nj, for 
some i = 1, 2, 3 with z/„ — > oo. 

Let S n Ni 3 i^n = {kn^^n-tn) ^ OO. Then t„ = 2p„ e {0,K{kn)), r„ = 
((/?„ + t„)/2 G (0,iir(A;„)). If kn is separated from 1, then r„ are bounded, 
thus tn, (fn are bounded, a contradiction. Thus fc„ ^ 1 for a subsequence (we 
will assume that this holds for the initial sequence) . 

If (7n,c„) (±7r,0), then {0t,yt) 0, thus i?i ^ 0, a contradiction. Thus 
the sequence (7n,c„) is separated from the point (±7r,0). 

Then there exists a sequence such that fc„ 1 and (pn ^ f (— oo,+oo), 
thus tn +00, pn +00, T„ +00. Then (p„ - E(p„))/(A;„a/A) oo, 

f2{Pn,K)/{K^) OO. 

If cn(r„) is separated from zero, then i?i ^ oo (see Eq. (5.5) [8]). And 
if cn(T„) is not separated from zero, then there exists a sequence such that 
cn(r„) — > 0, thus sn(T„) is separated from zero, then i?2 ^ oo (see Eq. (5.6) [8]). 

So the hypothesis 5 n Ci 3 Vn = {kn, ipn, tn) oo leads to a contradiction. 

Similarly the hypotheses CC\Ci 3 Vn ^ oo, z = 2, 3, lead to a contradiction. 

Thus the set S = Exp~^(i(') is bounded. 

(2) We show that S is closed. Let {vn} C S, we have to prove that there 
exists a subsequence converging in D2. By contradiction, let ^ oo or 
Un ^ V G dD2. 

Consider the case = (t„,p„, kn) € S H Ni. 
If kn 0, then {x, y) 0, thus i?2 ^ 0, a contradiction. 
Let kn 1. If (7n,c„) (±7r,0), then {e,y) (0,0), thus iii ^ 0, a 
contradiction. 

If (7n,c„) (7, c) ^ (±7r,0), then 1/ e A^3, a contradiction. 
Thus kn ^ k e (0,1). Then r„ ^ r e [3K{k),4:K{k)]. If r = 3ii', then 
i?i — > 0, and if r = then i?2 — > 0, a contradiction. Thus t„ — > r € 

{SK{k),4K{k)). 

Further, p„ ^ p e [0, Jsr(A:)]. If p = 0, then t = and i?2 ^ 0. If p = /C, 
then Ri 0. Thus Pn ^ p € (0, ii'). 

So {Tn,Pn,kn) {T,p,k) € Ni, & Contradiction. 

We proved that any sequence i/„ e SdNi contains a subsequence converging 

in D2- Similarly one proves the same for a sequence Vn €^ S C] Ni, i = 2,3. 

Thus any sequence Vn ^ S contains a subsequence converging in D^, thus 
converging in S. So the set S = Exp~^(iV') is closed. □ 

Theorem 3.1. For any i = 1, . . . ,8, we have Exp(Z>j) c Mi, and the mapping 
Exp : Di ^ Mi is a diffeomorphism. 

Proof. The inclusion Exp(Di) C Mi was proved in Lemma 3.2. The map- 
ping Exp : Di Mi is smooth, nondegenerate (Lemma 3.3), and proper 
(Lemma 3.4), thus it is a covering. Since Mi is simply connected, the mapping 
Exp : Di — > Mi is a diffeomorphism. □ 
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Lemma 3.5. Exp(7V4) = {q e M \ Ri = R2 = 0} = {q e M \ x = y = 0}, 
Exp(iV5) = {<? e M I i?i = 0, i?2 7^ 0, 9 = 0} = {qe M \ x^0, y = 0, 0^0}. 

Proof. Follows immediately from the corresponding formulas for extremal tra- 
jectories of Subsec. 3.3 [8]. □ 

Lemma 3.6. Exp(7V') C Af. 

Proof. Follows from formulas (5. 2)-(5. 11) [8]. □ 

Theorem 3.1 implies the following statement. 
Corollary 3.1. The mapping Exp : N M is a diffeomorphism. 

In view of Lemma 3.6, for any q ^ M there exists a unique — (A, i) = 
Exp-\q)eN,X^X{q),t = t{q). _ 

The diffeomorphism Exp : N = U^^iDi ^ M = uf^j^M^ is schematically 
shown at Fig. 10. 
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Figure 10: Global structure of exponential mapping 
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3.3 Cut time 

Theorem 3.2. For any qi G M, let {Xi,ti) = Exp"^(gi) e N. Then the 
extremal trajectory q{s) = Exp(Ai, s) is optimal with q{ti) = q\. 
Thus optimal synthesis on the domain M is given by 

Ui{q) = hi{X), 1=1,2, {X,t) = Ex^p-\q) G N, q€M. 

Proof. Let qi € M. There exists i^i = {Xi,ti) e N = N U N' such that 
the trajectory q{s) = Exp(Ai,s) is optimal and q{ti) = Exp(z/i) = qi. By 
Lemmas 3.5 and 3.6, we have ui G N. By Cor. 3.1, there exists a unique ui G N 
such that Exp(z^i) = qi. So q{s) = Exp(Ai,s) is a unique optimal trajectory 
coming to gi. □ 

In work [8] we introduced the following function t : C {0, +oo] on the 
phase cylinder of pendulum (2S}^) xRc = C = uf^^C^: 



A e Ci 




t(A) 


- 2K{k), 


(3.3) 


XGC2 




t(A) 


= 2kp\{k), 


(3.4) 


AeCs 


=> 


t(A) 


= +00, 


(3.5) 


AeC4 




t(A) 


= TT, 


(3.6) 


AeCs 




t(A) 


= +0O. 


(3.7) 



and proved the inequality tcut(A) < t(A). Now we prove the corresponding 
equality. 

Theorem 3.3. For any X G C we have tcut(A) = t(A). 

Proof. We proved the inequality icut(A) < t(A) in Th. 5.4 [8]. 

(1) Consider first the generic case Ai G uf^j^C;. There exists ti G (0,t(Ai)) 
and arbitrarily close to t(Ai) such that snn cnn 7^ 0. Then I'l = {Xi,ti) G N, 
thus qi = Exp(!/i) G M. By Th. 3.2, the trajectory q{s) = Exp(Ai, s), s G [0, ti], 
is optimal, thus ti < tcut('^i)- 

So there exists ti G (0,t(Ai)) arbitrarily close to t(Ai) such that ti < 
icut(Ai). Consequently, t(Ai) < icut(Ai). 

We proved that tcut('^i) = t(Ai) for any Ai G Uf^^Ci. 

(2) If A € C4, then the extremal trajectory {x,y,9) = {0,0, ±t) is a Rie- 
mannian geodesic for the restriction of the sub-Riemannian problem on SE(2) 
to the circle {{0,0,9) \ 6 G S^}. It is optimal up to the antipodal point, thus 
icut(A) =7r = t(A). 

(3) In the case A e C5 the extremal trajectory is a line {x, y, 6) = {±t, 0, 0), 
thus it is optimal forever: tcut(A) = +00 = t(A). □ 



22 



4 Structure of exponential mapping 
at the boundary of open stratas 

In this section we describe the action of the exponential mapping 
Exp : N' = N\N ^ M' = M\M. 

4.1 Decomposition of the set A^' 

Consider the following subsets of the set 

N' = N\N ={{X,t) e uf^iNi I i = t(A) or snr cnr = 0} U iV4 U A/'s : 

N,^i = {{X,t)GN\t = t{X)}, (4.1) 
iVeonj = {{X,t) €N2\t = t(A), snr = 0}, (4.2) 

iVMax - iVcut \ A^conj , Arrest = iV' \ A^cut • 

So we have the following decompositions: 

N^NUN', iV' = iVeutUiVrcst, iVcut = iVMaxUiVeo„j. (4.3) 

In order to study the structure of the exponential mapping at the set A'^', we 
need further decomposition into subsets i = 1, ... ,58, defined by Table 3. 
Images of the projections 

Ar-n{i<t(A), snr CUT = 0} ^ {p = 0}, (fc, T,p) (fc, r, 0), 
Nln{t = t(A)} ^{p = 0}, {k,T,p) ^ {k,T,Q), 

are shown respectively at Figs. 11, 12. 

Table 3 provides a definition of the sets N'f, e.g., the second column of this 
table means that 

N[ = {{X,t) &N \ X&Cl, T&{Q,K), pG{0,K), fce(0,l)}. 
Introduce the following index sets for numeration of the subsets A^,': 

/={1,...,58}, C={1,...,34}, J ={26,28,30,32}, (4.4) 

ii = {35,...,58}, X = C\J. (4.5) 

Notice that I = CUR, .J cC. 

Lemma 4.1. (1) We have N[ n A'j = for any distinct i,j £ I. 
(2) There are the following decompositions of subsets of the set N' : 

Ncnt = ^iecNl, ATconj = UiejAr;, Af.est = UieijA^;, 

thus 

iVwax = U.ejf A^;, (4.6) 
N' = Uie/TV;. (4.7) 
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Table 3: Definition of sets M 
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Proof. Both statements (1), (2) follow directly from Table 3, definitions of the 
sets N', Nuax, Ncnt, A'^conj, Arrest, and decompositions (4.3). □ 

4.2 Exponential mapping of the set N^^ 

In order to describe the image Exp(7V35), we will need the following function: 

Rl{e) = 2(artanh(sin(6'/2)) - sin(6l/2)), G [0, tt). (4.8) 

It is obvious that Rj e C°°[0,7r), i?f(0) = 0, i?f(6') > for 6* G (0,7r), 
lim0^^_o -Ri(^) = +0O, and 



_-(o) = o. 

A plot of the function Rl{6) is given at Fig. 13. 

e 



(4.9) 




Ri 



Figure 13: Plot of Ri = RKO) 



Define the following subset of the set M': 

M^5 = {gGM|0G(7r,2^), R, e {0, Rl{2Tr - 6)), i?2 = 0}. 

Lemma 4.2. The mapping Exp : N^^ M35 is a diffeomorphism of 2- 
dimensional manifolds. 

To be more precise, we state that Exp(iV35) — Afgg and Exp|^,^ is a diffeo- 
morphism of the manifold N^^ onto the manifold M35. Below we will write such 
statements briefly as in Lemma 4.2. 

Proof. Formulas (5.2)-(5.6) [8] imply that in the domain N^^ we have the fol- 
lowing: 



sin(6'/2) = snp , 
i?i = 2(p-E(p))/fc, 



cos(6l/2) = -cnp, (4.10) 
R2 = 0. (4.11) 
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By Th. 2.6, the restriction Exp|^, is nondegenerate. Thus the set Exp(7V35) is 
an open connected domain in the 2-dimensional manifold 

S={qeM\ee{-n, 27r), Ri > 0, R2 = 0}. 

On the other hand, the set A^gg is an open connected simply connected domain 
in the 2-dimensional manifold 

T = {iy€Ni\T = 0, p€{0,K), k€ (0,1)}. 

In the topology of T, we have 

aAT^s = uUm, 

ni = {iy G Ni\t = 0, p=0, fc S [0, 1]}, 

n2 = {v e Ni \ T = 0, p € [0, n/2] k 0}, 

ns = {i^ G iVi I T = 0, p = K{k), k e [0, 1)}, 

n4 = {ly € Ni \ T = 0, p G [O.+oo), k = 1]}, 

see Fig. 14. 




Figure 14: Domain A^35 Figure 15: Domain M35 

We have 

Exp(ni) =mi = {qeM\e = 2TT, i?i = 0, R2 = 0}, 

Exp(n2) = m2 = {q e M \ e € [n,2TT], Ri = 0, R2 = 0}, 

Exp(n3) =m3 = {qeM\e = n, Ri > 0, R2=0}, 

Exp(n4) = 7714 = {g e M I ^ e [tt, 27r], Ri = i^?(27r - 0), R2 = 0}, 

moreover, dM^^ = uf^imj, see Fig. 15. 

(a) We show that Exp(Af^5) n M^g ^ 0. Formulas (4.10), (4.11) give the 
following asymptotics as A; ^ 0: 

e = 2Tr-2p + o{l), Ri = k{p/2-{sm.2p)/A)+o{k). 
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There exists (p, k) close to {tt/2, 0) such that the corresponding point {6, Ri) is 
arbitrarily close to (0,0), with 6* > 0, i?i > 0. Thus there exists i/ G N^^ such 
that Exp(z/) e M^g. 

(b) We show that Exp(7V^5) ^ 5. Formulas (4.10), (4.11) yield the following 
chain: 

9^2^-0 => snp ^ p^O i?i ^ 0. 

Thus there exists q £ S \ Exp(iV35). 

(c) We prove that Exp(A^35) C -M35. By contradiction, suppose that there 
exists a point qi € Exp(iV3g) \ ^^35. Since the mapping Exp|^, is nondegener- 
ate, we can choose this point such that qi G Exp(A^35) \ cl{M^^). 

Choose any point 92 € S'\cl(M35). Connect the points qi, 92 by a continuous 
curve in S, and find at this curve a point q^ G S \ Exp(iV35), q-^ ^ c^A'/gg) such 
that there exists a converging sequence q^, = Exp(z/") e Exp(Af35). 

Further, there exist a subsequence z/"* € N^^ converging to a finite or infinite 
hmit. If i^"' ^ D G A^35,then q^ — Exp(f') S intExp(A^35) by nondegeneracy of 
Expljy,^, a contradiction. If i/"' D £ dN^^, then 

93 = Exp(i/) e Exp(a7V^5) = aM^5 c cl(M^5), 

a contradiction. Finally, if v"'' — > 00, then at this sequence A;"* — > 1 — 0, 
p"' 00. thus _Ri((j"») 00, a contradiction. 

Consequently, Exp(A'^^5) C M35. 

(d) The mapping Exp : TVgg — > M35 is a diffeomorphism since Exp|jy^, is 

35 

nondegenerate and proper, and iVgg, M35 are connected and simply connected. 

□ 

4.3 Exponential mapping of the set N'^,^ 
Define the following subset of M': 

M^^ = {q€M\0€ (7r,27r), Ri = iif(27r - 6*), R2 = 0}. 

Lemma 4.3. The mapping Exp : N^,^ — > M47 is a diffeomorphism of 1- 
dimensional manifolds. 

Proof. We pass to the limit — > 1 — in formulas (4.10), (4.11) and obtain for 

sin{e/2) = tanhp, cos(6l/2) = -1/coshp, Ri = 2{p - tanhp), R2 = 0. 

This coordinate representation shows that Exp : N^^^ — > M47 is a diffeomor- 
phism. □ 
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4.4 Exponential mapping of the set A^26 

Before the study of Exp|jY/_^, postponed till the next subsection, we need to 
consider the set contained in the boundary of N^2- order to parametrize 
regularly the image Exp(A^26)' introduce the necessary functions. 

Recall that the function p = pl{k), k G [0,1), is the first positive root of 
the function = cnp(E(p) —p) — dnp snp, see Eq. (5.11) and Cor. 5.1 [8]. 
Define the function 

vl{k) ^a.m{p\{k),k), fee [0,1). (4.12) 

Lemma 4.4. (1) The number v = vl{k) is the first positive root of the func- 
tion 

hi{v,k) = E{v,k) - F{v,k) - Vl- Psin^tanw, k € [0,1). 

(2) vl e C°°[0,1). 

(3) vl{k) e {■it/2, it) for k G (0, 1); moreover, vl{0) = n. 

(4) The function vl{k) is strictly decreasing at the segment k e [0, 1). 

(5) lim^^i_o (fc) ~ tt/2, thus setting vl{l) — tt/2, we obtain vl G C[0, 1]. 

(6) vl{k) = TT - (7r/2)fc2 + o(fc2). k ^ +0. 

Proof. (1) follows from (4.12) since p = pi is the first positive root of the 
function /i(p). 

(2) follows since pi e C°°[0, 1) by Lemma 5.3 [8]. 

(3) follows since pi e {K, 2K) and pl{Q) = tt, see Cor. 5.1 [8]. 

(4) We have for v € (7r/2,7r]: 

9 hi r ~ ; 5 , o ^ 

— — = — Vl — K sm I)/ cos u < 0, 
ov 

^ = -:; ^(E{v,k) - a/i - fc2 sin^vtsmv) < 0. 

ok 1 — k-' 

r^, dv] dhi/dk „ „ , .„ 
Thus — ^ = -T^T^ < for fc e 0, 1 . 
dk ohi/ov 

(5) Monotonicity and boundedness of f J(fc) imply that there exists a limit 
limfe^i_o fi(fc) = V G [7r/2,7r). If u € (7r/2,7r), then as fc — » 1 — 

h\{vl{k),k) ^ / (I cos^l — 1/1 cost|) dt—^/l — sin^ t;tant; = 00, 
Jo 

which contradicts the identity hi{vl{k), k) = 0, k G [0, 1). Thus v = 7r/2. 

(6) As {k,v) (0,7r), we have hi{v,k) = v - n + {tt /2)k^ + o{k^ + {v - n)"^), 
thus vl{k) =TT- (7r/2)A;2 + o{k'^), k ^ +Q. □ 
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V 




Figure 16: Plot of v — vl{k) 



Figure 17: The curve Fi 



A plot of the function vl{k) is given at Fig. 16. 

Define the curve Ti C S = {q e M \ 9 e (0,^), Ri > 0, i?2 = 0} given 
parametrically as follows: 



see Fig. 17. 

Lemma 4.5. (1) The function fcsinuj(fc) is strictly increasing as k G [0,1], 
thus the function = 0{k), k G [0, 1], determined by (4.13) has an inverse 
function k = kl{6), 6 G [0,7r]. 

(2) kl e C[0,7r] nC~[0,7r). 

(3) The function kl{0) is strictly increasing as 9 £ [0,7r]. 

(4) The curve Ti is a graph of the function 

Ri=Rli0), 0G[O,7r], 

Rl{9) = 2{F{vl{k),k) - E{vl{k),k)), k = kl{9). (4.15) 

(5) Rl e C[0,7r] nC°°(0,7r). 

(6) Rl{9) = ^/2^2/3 + 0(^2/3)^ Q ^ +0. 
Proof (1) As fc e [0, 1], we have: 

vlik) i, vlik) G [7t/2,7t], 

smvl{k) t; fcsint;{(fc) t) 2 arcsin(A;t;i (A;)) t • 

(2) follows from items (2), (5) of Lemma 4.4. 

(3) follows from item (1) of this lemma. 

(4) follows from (4.13), (4.14). 



9 = 2arcsin(A:sinw{(/c)), 

R^ = 2{F{vl{k),k)-E{vl{k),k)), 



k G [0, 1) 



(4.13) 
(4.14) 
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□ 



(5) follows from item (2) of this lemma. 

(6) As k ^ +0, wc have 

vl{k) = TT - (7r/2)fc2 + o{k^), sinvlik) = {w/2)k^ + o{k^), 
and for the functions (4.13), (4.14) 

e = Trk^ + o{k^), Ri = (7r/2)fc2 + o{k^). 
Thus as ^ — > +0, we have 

kl{e) = ^/ejTT + o{\/e), r\{6) = ^/2e^/^ + o{0^/^). 

Define the following subset of M': 

M'^Q = {q£M\ee (tt, 27r), Ri = R\{2t: - 6), R2 = 0}. 

Lemma 4.6. The mapping Exp : N^q M^g is a diffeomorphism of 1- 
dimensional manifolds. 

Proof For v e N^q we obtain from formulas (5.7)-(5.12) [8]: 

sin((?/2) = ksnp\{k) ~ ksmvl{k), 

cos(0/2) = -dnpj(fc) = -^1 - fc2 sin^ v{{k), 

R, = 2{pl{k) - E{pl{k)) = 2{F{vl{k),k) - E{vl{k),k)), 
i?2 = 0. 

Thus Exp(iV2g) = M2Q- Moreover, the mapping Exp : decomposes 
into the chain 

iv^g r, M^g, 

(*) : fch^ (6l = 2arcsin(A;sinwJ(A;)), Ri = 2{F{vl{k),k) - E{vl{k),k)), i?2=0), 
(**) : {e,RuR2)^{27T-e,Ri,R2). 

The mapping (*) is a diffeomorphism by Lemma 4.5. Thus Exp : — > M2g 
is a diffeomorphism. □ 

4.5 Exponential mapping of the set 

Lemma 4.7. (1) The functions R\{9), R\{0) defined in (4.15), (4.8) satisfy 
the inequality 

Rl{9)<Rl{0), 9€{0,-k). 

(2) The mapping Exp : N^2 ~^ ^52 diffeomorphism of 2-dimensional 

manifolds, where 

M'r,2 = {qeM\0e{Tr,2TT), Ri £ {RI{2tt - 0) , Rl{2n - 9)) , R2 = 0}. 
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Proof. We have 

N;,^ = {u€N+ \ t = 0, v€{0,vl{k)), fee (0,1)}, 
where v = am(p, k). Thus 

N^^CT^{iyeN+ \ t^0, v€[0,Tr], fee [0,1]}, 
and in the 2-dimensional topology of T 

dN^^ = uUm, 

m = {ly e \ T = 0, v = o, kG [0, 1]}, 

n2 = {ly e N+ \t = 0, VG [0,7r], k = 0}, 
ns = {ly e N+ \t = 0, v = vl{k), k e [0, 1]}, 
nA = {ly e N+ \t = 0, vG [0,7r/2], k = 1}, 



see Fig. 18. 




Figure 18: Domain N^2 Figure 19: Curves 72 and r2 

By formulas (5.7)-(5.12) [8], the exponential mapping in the domain N^2 
reads as follows: 

sin(^?/2) — ks'mv, co&{0/2) = — \/l — fc^ sin^ v, 

Ri = 2{F{v,k) - E{v,k)), R2 = 0. 

Thus 

Exp(Af^2) cS^{qeM\9G (7r,27r), i?i > 0, i?2 = 0}, 
Exp(ni) = Exp(n2) Pq = {q e M \ 9 = 2tt, Ri = 0, R2 = 0}, 
Exp(n3)-M^-r^, r2:=M^e, 
Exp(n4) = MJ^ = 72, 72 := M'^^. 



32 



By Th. 2.6, the mapping Exp|^/ is nondcgcncratc, thus Exp(A'^2) is an open 

connected domain in S, with dExp{N^2) C Exp(9iV52) = r2 U 72 • 

The curves r2 and 72 intersect one another at the point Pq. We show 
that they have no other intersection points. By contradiction, assume that the 
curves r2 and 72 have intersection points distinct from Pq, then the domain 
Exp(iV52) is bounded by finite arcs of the curves r2 and 72, i.e., there exists 
a poi nt Pi e 7 2 nr2, Pi ^ Pa, such that aExp(7V^2) = -P072-P1 U Por2Pi. 
Then Exp(A^52) does not contain the curves 72, r2. This is a contradiction to 
the diffeomorphic property of the mapping Exp : = N!^^ ^ r2 = Mjg and 
Exp : Ui = N^j 72 = Af47, see Lemmas 4.6 and 4.3 respectively. 

Consequently, fl r2 = Pq, and the domain Exp(iV52) is bounded by the 
curves 7^, r2. 

d d R"^ 

The equalities -7^(0) = +00, -7^(0) = (see Lemma 4.5 and Eq. (4.9)) 
du do 

imply that Ri{6) < Ri{0) for sufficiently small ^ > 0. Further, the representa- 
tions 

T2 = M^Q = {qeM \ee (7r,27r), Ri = J?l(27r - 6), R2 = 0}, 
72 = = {g e M I ^ e (tt, 27r), Ri = Rl{2n - 6), R2 = 0} 

imply the required inequality 

Rl{0)<Rl{0), ee(0,7r), 

and the equality Exp(7V52) = M^2- 

Since the mapping Exp : ~^ ^52 is nondegenerate and proper, and the 
domains iVg2, M52 are open, connected, and simply connected, it follows that 
this mapping is a diffeomorphism. □ 

The mutual disposition of the curves 72 = M47 and r2 = M2Q is shown at 
Fig. 19. 



4.6 Decomposition of the set M' 

Now we have the functions Ri{0) < Ri{0) required for definition of the following 
decomposition: 

M' = ufiiMi, (4.16) 

where the subsets are defined by Table 4. Notice that some of the sets M- 
coincide between themselves, unlike the sets N^, see (4.7). 

The structure of decomposition (4.16) in the surfaces {6 = 0}, {0 = tt}, 
{Pi = 0}, {P2 = 0} is shown respectively at Figs. 20, 21, 22, 23. 

4.7 Exponential mapping of the set N^q 

Lemma 4.8. The mapping Exp : A^3g — > Mgg is a diffeomorphism of 2- 
dimensional manifolds. 
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Mi 


M[ = M'q 






= 


= 


Mil = 





TT 


TT 


TT 


TT 


(7r,27r) 


(0,^) 


Ri 


(0,+oo) 


(-«3,0) 


(-«3,0) 


(0,+(X)) 


(i?i(27r-e),+oo) 


(-oo,-iii(e)) 


R2 


(-00,0) 


(-00,0) 


(0,+oo) 


(0,+oo) 









M[ 


M[, = M[, 


= 


M[, = 


Mis = 







(0,^) 


(7r,27r) 


TT 


TT 


TT 


Ri 


(i?l(0),+oo) 


(-oo,-i?{(27r- ^)) 


(O.+oo) 





(-00,0) 


R2 











(-00,0) 






M[ 


M^o = 












M32 





TT 





2^) 







{0,tt) 


(7r,27r) 


Ri 





(-00,0) 


i?i(27r-6') 


-Rm 


(0,+oo) 


Ri{0) 


-Ri{2n-0) 


R2 


(0,+oo) 























M^3 = 










Ml,, 





TT 


(7r,27r) 


(7r,27r) 


27r) 


(^,27r) 


(0,7r) 


Ri 





(O,ii?(27r-0)) 





i-Rl{27r-0),O) 





(-i??(0),O) 


R2 








(-^,0) 





(0,+oo) 






Mi 




Mi, 


Mi, 


M^3 


Mi, 




Mie 


Mir 





(0,7r) 


{0,n) 


{0,tt) 


(7r,27r) 


{0,n) 








{n,2w) 


Ri 





{ilRi{0)) 

















R{{2-K-0) 


R2 


(-00,0) 





(0,+oo) 








(0,+oo) 


(-00,0) 






Mi 


Mis 


Mi, 






^52 


A^53 





(tt, 2tt) 


(0,^) 


(0,^) 





(tt, 27r) 





Ri 


-RI{2tt - 0) 






(-c^,0) 


(i?^(27r-6'),i?}(27r-6»)) 


(-00,0) 


R2 











(-00,0) 





(0,+oo) 



Mi 


MU 


MU 


^56 


M;^r 


^58 





(0,7r) 





(0,7r) 





(7r,27r) 


Ri 


i-Riie),-Rm) 


(0, +00) 




(0,+oo) 


(-i?i(27r-6'),-ii^(27r-6»)) 


R2 





(-00,0) 





(0,+oo) 






Table 4: Definition of sets Mi 
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M: 



Mil 



Ri = y 



m9 = Mil 



Mir 



Mi =Mi 



n,-x ^1^ = ^^' 



Mis = Mir 



Mis 



Mi = Mi 



R2 



Mio 



Mi = M| 



Mi, 



^ Ij.^ = Mj, M[^ = M j-, 



Ri 



Mis = Mi, 



M[ = Mi 



Figure 20: Decomposition of surface 
{^ = 0} 



Figure 21: Decomposition of surface 
{6 = ^} 



Mio 

M[s = Mi, ^ 


Mis Mis 

Mi^ = Mi^ Mi^ = Mi, 


Mio 
Mi, 


IT 

Mi, Mi, 
Mi, 



R2 



Figure 22: Decomposition of surface {i?i = 0} 
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e 2-K 




Figure 23: Decomposition of surface {i?2 = 0} 



Proof. By formulas (5.2)-(5.6) [8], exponential mapping in the domain N'^^ reads 
as follows: 

sin(^/2) = — fc2 snp/ dnp, cos(^/2) = — cnp/dnp, 

i?i = 0, R2 = -2f2{p,k)/{kdnp), 

where f2{p,k) = cnp snp + dnp(p — E(p)) > by Lemma 5.2 [8], thus 
Exp(iV^e) c M^e- 

In the topology of the manifold {Ri = 0}, we have: 

ni = {iyeN^\T^K, p^O, ke [0, 1]}, 
n2 = {i/ e 7V° I r = if, p e [0,7r/2], k = 0}, 
na = {zy e TV? I r = i^, p = if, fc e [0, 1)}, 
m = {u e \ T = K, p € [0,= oo), k = 1}, 

see Fig. 24. 

Further, we have Exp(ni) = rrii, i = 1, . . . ,4, where 

mi = {qGM\e = 2'jT, Ri = 0, R2 = 0}, 

m2^{qeM\9e [tt, 27r], i?i = 0, i?2 = 0}, 
m3 = {qeM\0 = TT, i?i = 0, i?2 e (-00, 0]}, 
m4 = {qeM\0 = 2n, Ri = 0, R2 & (-00, 0]}, 
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p 




Figure 24: Domain A^3g Figure 25: Domain M^q 

see Fig. 25. 

The mapping Exp : N'^^ Mgg is nondegenerate and proper, the domains 
iVgg, Mgg are open (in the 2-(limensional topology), connected and simply con- 
nected, thus it is a diffeomorphism. □ 

4.8 Exponential mapping of the set A^gg 

Lemma 4.9. The mapping Exp : A^gg — > M53 is a diffeomorphism of 2- 
dimensional manifolds. 

Proof. The argument follows similarly to the proof of Lemma 4.8 via the follow- 
ing coordinate representation of the exponential mapping in the domain N^^: 

e = 0, Ri = -2V1 - fc2(p-E(p))/dnp < 0, R2 = -2kfi{p,k)/diip, 

where fi{p,k) = cnp(E(p) — p) — dnp snp < for p e (0,p}), see Cor. 5.1 [8]. 

□ 

4.9 Exponential mapping of the set N[g 

Lemma 4.10. The mapping Exp : A''{g —^ M[g is a diffeomorphism of 1- 
dimensional manifolds. 

Proof. By formulas (5.2)-(5.6) [8], we have in the set A^{g: 

6i = 7r, i?i = 0, R2 = -2/k{K{k)-E{k)), 

and the difFeomorphic property of Exp|^/ follows as usual from its nondegen- 
eracy and properness, and topological properties of the sets N[^, M(g. □ 



37 



4.10 Exponential mapping of the sets N^^, N!^^ 

Lemma 4.11. The mappings Exp : N'^^ M33 and Exp : ^^34 M34 are 
diffeomorphisms of 0-dimensional manifolds. 

Proof. Obvious. □ 

4.11 Exponential mapping of the set A^^y 

Lemma 4.12. The mapping Exp : N[j — > M^^ is a diffeomorphism of 1- 
dimensional manifolds. 

Proof. The statement follows as in the proof of Lemma 4. 10 via the following 
coordinate representation of the exponential mapping in the domain N[f. 

e = TT, i?i = 2/k{K{k) - E{k)), R2 = 0. 

□ 

4.12 Exponential mapping of the set A^27 

Lemma 4.13. The mapping Exp : A^27 ~^ ^27 diffeomorphism of 2- 
dimensional manifolds. 

Proof Formulas (5.7)-(5.12) [8] yield: 



' = 7r, 



Rr = -20^ {p - E(p))/dnp \^^^,^^^ , iij = 0. 



Since t = K, then Lemma 2.4 gives J < 0, thus the mapping Exp|jy,^ is 
nondcgenerate. Then the diffeomorphic property of Exp : A^j? ~* -^27 follows 
as usual. □ 

4.13 Exponential mapping of the set N[ 

Lemma 4.14. The mapping Exp : A''( M[ is a diffeomorphism of 2- 
dimensional manifolds. 

Proof Formulas (5.2)-(5.6) [8] yield: 

e = -K, Ri = 2{K{k) - E{k))c7iT /{kdnr) > 0, 
R2 = -2V1 - k'^{K{k) - E{k)) snr /(fcdnr ) < 0, 

and the statement follows as usual since the mapping Exp|^, is nondegenerate. 

□ 
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4.14 Exponential mapping of the set A^{q 

Lemma 4.15. The mapping Exp : A^{o ~* -^lo ^ diffeomorphism of 2- 

dimensional m,anifolds. 



Proof. By formulas (5.7)-(5.12) [8] we get: 
sm{9/2) = ksnp\cnT /VA > 0, 

>0, 



Ri = 2(p-E(p))diir/VA 



cos (61/2) 
R2 = 0, 



■ diipJ/\/A < 0, 



where A = 1 ~ k'^ sn^ p sn^ r , and the statement follows by standard argument 
since Exp|^, is nondegenerate and proper. 



□ 



4.15 Action of the group of reflections in the preimage 
and image of the exponential mapping 

In order to extend the results of the preceding subsections to all 58 pairs 
{N^, Ml), we describe the action of the group of reflections G = {Id, e^,. . ., e"^} 
on these sets. 
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Table 5: Action of e\ on N^, N'„, N^, N[^, N^. 
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Table 6: Action of e^, on Nl^, 
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Table 7: Action of e\ e^, on 
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Table 8: Action of £\ e^, on Ml^^, M'„, M^, M[^, M^, 
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^2 


ML 



Table 9: Action of e^, on 
Mis 



D 






e\D) 


K 




e\D) 


K 




e\D) 






e\D) 




K2 








e%D) 




Nil 






Nii 



Table 11: Action of e^, . . . , on 

Ni, Nia 



D 


^53 


Mf,r 


sHd) 




ML 


e\D) 


ML 






MU 





Table 10: Action of e\ e^, on 
Mis, M'^, 



D 


Mi 


Mio 


s\D) 




Mi, 


e\D) 


Mi 


M'g 


e\D) 


M3 


Mi, 


e\D) 


M^ 


Mi, 




M^ 


Mi, 


e%D) 


Ml, 


Mi, 




M^ 


Mii 



Table 12: Action of e^, . . . , e'^ on 
Mi, M(o 



Theorem 4.1. Tables 5, 6, 1, 11 and 8, 9, 10, 12 define diffeomorphisms 
between the corresponding manifolds N- and M-. 

Proof. Follows from definitions of the manifolds N- and (Subsections 4.1 
and 4.6) and Propositions 4.3, 4.4 [8] describing action of the reflections e 
G in the image and preimage of the exponential mapping. Moreover, in the 
coordinates {6, i?2) action of the reflections is described by Table 13. □ 





£1 










£6 




Ri 


-Ri 


Ri 


-Ri 


-Ri 


Ri 


-Ri 


Ri 


R2 


R2 


-R2 


-R2 


R2 


R2 


-R2 


-R2 


e 


6 


6 


6 


27r-e 


277-9 


2-K-e 


2iT-6 



Table 13: Action of £\ . . . , on M = R2, 6)} 



4.16 The final result for exponential mapping 

of the sets N[ 

Theorem 4.2. For any i & I, the mapping Exp : A^^' — » M- is a diffeomorphism 
of manifolds of appropriate dimension 2, 1, or 0. 

Proof For i e {35, 47, 26, 52, 36, 53, 18, 17, 27, 1, 10} the statement follows from 
Lemmas 4.2, 4.3, 4.6, 4.7, 4.8, 4.9, 4.10, 4.12, 4.13, 4.14, 4.15 respectively. 
For i e {33,34} the statement was proved in Lemma 4.11. 



40 



For all the rest i the statement follows from the above lemmas and Th. 4.1 
since the reflections £* G G are symmetries of the exponential mapping, see 
Propos. 4.5 [8]. □ 



4.17 Reflections as permutations 

In addition to the index sets 7, C, J, R, X introduced in (4.4), (4.5), we will 
need also the set 

T={{i,j)&IxI\i<j, M[ = M'^}. 

From the definition of the sets in Subsec. 4.6 we obtain the explicit repre- 
sentation: 

T={(1,6), (2,5), (3,8), (4,7), (9,10), (11,12), (13,14), (15,16), 

(17,23), (18,22), (19,21), (20,24), (25,27), (29,31), (33,34)}. 

Notice that X = {i e I \ 3j & I : {i,j)eT or (j,i) e T). 

Now we show that reflections s'' G G permute elements in any pair € T. 

We will need multiplication Table 14 in the group G, which follows from 
definitions of the reflections e*^ (Sec. 4 [8]). The lower diagonal entries of the 
table axe not filled since G is Abelian. 





£l 




£^^ 


£4 


£^ 


£« 






Id 








£4 




£« 






Id 


£l 


£« 






£-^ 








Id 




£^ 




£4 


£4 








Id 


£l 




£^ 


£^ 










Id 


£^ 




£« 












Id 


£l 


e' 














Id 



Table 14: Multiplication table in the group G 



Lemma 4.16. For any £ T there exists a reflection s'^ G G such that the 
following diagram is commutative: 



Id 



(A, t) qt 



Id 



(A'=,t)K^5'f 



Proof. From definitions of the sets A'^' (Subsec. 4.1) and the reflections 
(Sec. 4 [8]), Tables 5, 6, 7, 11, 14 and Propos. 4.5 [8], we obtain the foUow- 
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ing indices k of required symmetries e'^ for pairs G T: 



e {(1,6), (2,5), (3,8), (4,7), (17,23), (19,21)} k = 5, 

(i,j)e {(9,10), (15,16), (11,12), (13,14), (25,27), (29,31)} k = 2, 

(i,j) e {(33,34), (18,22), (20,24)} k = A. 

□ 

5 Solution to optimal control problem 

In this section we present the final results of this study of the sub-Riemannian 
problem on SE(2). 

5.1 Global structure of the exponential mapping 

We say that a mapping F : X — > F is double if any point y G Y has exactly 
two preimages: 

VyeF F-'^{y) = {xi,X2}, x^i-xi. 

Theorem 5.1. (1) There is the following decomposition of preimage of the 
exponential mapping Exp : N ^ M: 

N = NUN', 
N = A, 

N' = TVMax U TVconj U N,^,t, 
iVMax = UigxiV-, 
iVconj = U,6j7V;, 
Arrest = UieRN^, 

and in the image of the exponential mapping: 
M = MUM', 

M' = Mwax U Mconj U M^st, 

MMax = ^iexMl, 

M[ nM'^^(i), i< j {i, j) e T, {i, j} c X, 
(«,,?) er =^ M; = Mj, 

Meonj = UigjM;, 
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(2) In terms of these decompositions the exponential mapping Exp : N ^ M 
has the following structure: 

Exp : Di Mi is a diffeomorphism V « = 1, ... ,8, (5-1) 

Exp : Ml is a diffeomorphism Vie/. (5-2) 

Thus 

Exp : N ^ M is a bijection, (5.3) 

Exp : iViviax A^Max is a double mapping, (5.4) 

Exp : iVconj Afconj is a bijection, (5.5) 

Exp : Arrest ~^ -^rest a bijcction. (5.6) 

(3) Any point g € M (q G Mconj, q G M^^st) has a unique preimage v = 
Exp"^(g) for the mapping Expjj^ : M. Moreover, u G N (resp., 

y e A/conj, V e A/rest^- 

(4) Any point q G Mjviax has exactly two preimages {v' = Exp^^(g) for 
the mapping Expjj^ : A'' M. Moreover, u', u" e A^Max and u" = s''{u') 
for some e*^ G G. 

Proof. Equalities in item (1) follow immediately from definitions of the corre- 
sponding decompositions. 

(2) Property (5.1) was proved in Th. 3.1, and property (5.3) is its corollary, 
with account of item (1). Property (5.2) was proved in Th. 5.2, and proper- 
ties (5.4)-(5.6) are its corollaries, with account of item (1). 

(3) The statement follows from (5.3), (5.4), (5.5), (5.6), with account of item 

(l). 

(4) The statement follows from (5.4), (5.5), (5.6), and Lemma 4.16. □ 

5.2 Optimal synthesis 
Theorem 5.2. Let qgM. 

(1) LetqG MU Mconj U M^est = M \ MjMax- Denote v = (A,t) = Exp~^(q') e 

N U A^conj U Arrest = ^\ A^Max- Then q, = Exp(A,s), s^G [Q,t], is the 
unique optimal trajectory connecting q^ with q. If q € M U Mj-^st, then 
i < t(A); i/g G Mco„j, then t = t{X) = tl°'^\X). 

(2) Let q G MMax. Denote = Exp-i(g) C TVwax, v' = (A',i) ^ 
v" = {X",t). Then there exist exactly two distinct optimal trajectories 
connecting q^ and q; namely, q'^ — Exp(A',s) and q'J = Exp(A",s), s S 
[0,t]. Moreover, t = t(A) < t™"j(A). 

(3) An optimal trajectory q^ = Exp(A, s) is generated by the optimal controls 

Ui{s) = hi{Xs), A« = e^''(A), i = l,2. 
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Thus 

ui{s) = sin(7s/2), ^2(5) = -008(7^/2), 

where 7s is the solution to the equation of pendulum 7s = — sin 7s with the 
initial condition (70,70) = 

Proof. For any point q G M there exists an optimal trajectory qg = Exp(A, s), 
s G [0,t], ly = (A,i) e N, such that qt = q and t < tcut(A). By Th. 5.4 [8], we 
have t < t(A), thus v £ N. 

(1) If g G M U Mconj U -Mrest, then by Th. 5.1, there exists a unique v = 
(A, t) G N such that q = Exp(i/), moreover, v G A/'UA^conj U Arrest- Consequently, 
qs = Exp(A, s), s G [0,t], is a unique optimal trajectory connecting qo with q. 

The inequality t < t(A) for 1/ = {X,t) G N U N^est, and the equality t = 
t(A) = t^°"^(A) for 1/ G iVconj follow from definitions of the sets N, N^est, -^conj- 

(2) If q G A/Max- then the statement follows similarly to item (1) from Th. 5.1 
and definition of the set A^Max- 

(3) The expressions for optimal controls were obtained in Sec. 2 [8]. □ 

It follows from the definition of cut time that for any X G C and t G 
(0, tcut(A)), the trajectory q{s) = Exp(A, s) is optimal at the segment s G [0,t]. 
For the case of finite tcut(A), we obtain a similar statement for t = tcut(A). 

Theorem 5.3. //tcut(A) < +00, then the extremal trajectory Exp(A, s) is op- 
timal for s G [0,tcut(A)]. 

Proof Let icut(A) = t(A) < +00, i.e., A G Ci U C2 U C4, and let t = tcut(A). 
Then (A, t) G Nuax, and the statement follows from item (2) of Th. 5.2. □ 

5.3 Cut locus 

Now we are able to describe globally the first Maxwell set 

Max = {q G M \ 3t > 0, 3 optimal trajectories qs ^ q'^, s G [0,t], 

such that qt = Qi = <l}j 

the cut locus 

Cut = {Exp(A,i) \XgC, t = tcut(A)}, 

and its intersection with caustic (the frst conjugate locus) 

Conj = {Exp(A,i) I A G C, t = tl"''\X)}. 
Theorem 5.4. (1) Max = MMax, 

(2) Cut = Me,t, 

(3) Cut n Conj = Mconj. 
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Proof. Items (1), (2) follow from Theorem 5.2 and Corollary 5.3. 

(3) Let q G Mconj, and let Qs = Exp(A, s), s G [0,t(A), be the optimal 
trajectory connecting qo with q. Thus there are no conjugate points at the 
interval (O.t(A)). Wc show that t(A) is a conjugate time. 

Since q = Exp(A,t(A)) e M<.onj, then (A,t(A)) G A^conj, thus A € C2 and 
snr =0,p = pl{k), {k G (0, 1). Then Propos. 2.2 states that t(A) = 2fcpJ is a 
conjugate time. 

We proved that tl°'^\X) = t(A). Thus Mconj C Conj, and in view of item (2) 
of this theorem we get Mconj C Cut fl Conj. Now we prove that Cut fl Conj c 

Mconj, i-C, Mcut n Conj C Mconj- 

Fix any point q G Mcut- Then q = Exp{X,t) for some {X,t) G iVcut = 
^Max U Ncony In Order to complete the proof, we assume that {X,t) G A^Max 
and show that q ^ Conj. Since {X,t) G Nuax, then t = t(A). We prove that 

t <^^'(A)- 
If A G Ci U Ci, then f';°"j(A) = +00 by Th. 2.6. 

Let A G C2. If snr = 0, then {X,t) G A'^conj, which is impossible since 



(A,i) G iVMax- And if snr ^ 0, then t < f™"J(A) by Propos. 2.2. 

The inclusion Cut fl Conj c Mconj follows. □ 

Theorem 5.5. The cut locus has 3 connected components: 

Cut = Cutglob U Cut+^ U Cuti"^, (5.7) 

Cutglob = {(7 G M I = tt}, (5.8) 

Cut+^ = {g G M I G (-TT, Ti), i?2 = 0, i?i > R\m}, (5.9) 

Cuti;, = {geM|0G(-7r,^), i?2=0, Ri<-R\{\e\}, (5.10) 



where the function R\ is defined by Eq. (4.15). The initial point qo is con- 
tained in the closure of the components CutjJ^^., Cutj"^, and is separated from 
the component Cutgiob- 

Proof. By Theorems 5.4, 5.1 and Lemma 4.1, we have 

Cut = Mcut = Exp(A/-cut) = UiecM/. 

Denote 

Cgiob = {l,..-,8,17,...,24,33,34}, 
C+c = {13,...,16,29,...,32}, 
(7i;^ = {9,...,12,25,...,28}. 

Then 

Uiec,,o.M| = Cutglob, ^iec+^Ml = Cut+„ ^iec-^l = Cuti;„ 

and decomposition (5.7)-(5.10) follows. 

The topological properties of Cutgiob, Cutj^^ follow from equalities (5.7)- 
(5.10). □ 
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The curve T = CutnConj has the following asymptotics near the initial 
point g'o: 

i?i = i?i(6») = 6*2/3 + 0(6*2/'^), 61^0, i?2 = 0, 

see item (5) of Lemma 4.5. This agrees with the result on asymptotics of conju- 
gate locus for contact sub-Riemannian structures in obtained by A. Agrachev [1], 
and J.-P. Gauthier et al [4]. 




Figure 26: Cut point for A G Ci, 
generic case (Optimal solutions for 



Figure 27: Cut point for X € C\, 
symmetric case with cusp (Optimal 
solutions for xi ^ 0,yi = 0, 9i = n) 



5.4 Explicit optimal solutions for special terminal points 

In this subsection we describe optimal solutions for particular terminal points 
3i = {xi,yi,Oi)- Where applicable, we interpret the optimal trajectories in 
terms of the corresponding optimal motion of a car in the plane. 

For generic terminal points, wc clcvclopcd a software in computer system 
Mathematica [20] for numerical evaluation of solutions to the problem. 

5.4.1 xi ^ 0, ?/i = 0, 6ii = 

In this case v G N^, and the optimal trajectory is 

a;t = tsgna;i, yt = 0, Ot = 0, tG[0,ti], ii = |a;i|, 
and the car moves uniformly forward or backward along a segment. 

5.4.2 xi=0, 2/1 = 0, 1^1 1 G (0,7r) 

We have u G N4, and the optimal solution is 

xt = 0, yt = 0, et=tsgaei, t€[0,h], h = \ei\, 
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Figure 28: Cut point for A G Ci, sym- 
metric case without cusp (Optimal so- 
lutions for Xi = 0, t/i ^ 0, &i = tt) 



47 




Figure 29: Cut point for A € C2, Figure 30: Cut point for A € C2, 

generic case special case with one cusp 




Figure 31: Cut point for A e C2 Figure 32: Cut point for A S C2 

approaching conjugate point coinciding with conjugate point 
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Figure 33: Cut point for A G C4 (Opti- 
mal solutions for xi = yi = 0, 61 = w) 

the car rotates uniformly around itself by the angle 9i . 

5.4.3 xi = 0, 2/1 = 0, 6I1 = TT 

We have u G N4, and there are two optimal solutions: 

xt = 0, yt = 0, (9t = ±t, te [0, ii], ii = tt, 

the car rotates uniformly around itself clockwise or counterclockwise by the 
angle tt, see Fig. 33. 

5.4.4 xi 7^ 0, 2/1 = 0, 6I1 = TT 
There are two optimal solutions: 

Xt = {sgnxi)/k{t + E{k) - E{K + t, k)), yt = {s/k){^J\ - k"^ - AYi{K + t, k)), 
et = ssgD.xii'K/2- am{K + t,k)), s = ±1, t € [0,ti], ti = 2K, 

and fee (0,1) is the root of the equation 

{2/k){K{k)-E{k)) = \xi\, 
see Fig. 27. 
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5.4.5 xi = 0, j/i ^ 0, 6ii = TT 
There are two optimal solutions: 

xt = s{l-d.n{t,k))/k, yt = {sgiiyi/k){t - E{t,k)), 

6t = ssgnyia,m{t,k), s = ±1, tG[0,ti], t\ = 2K, 

and k & (0,1) is the root of the equation 

{2/k){K{k)-E{k)) = \yr\, 
see Fig. 28. 

5.4.6 xi = 0, yi 7^ 0, 6*1 = 

There are two optimal solutions given by formulas for {xt,yt,dt) for the case 
A e C2 in Subsec. 3.3 [8] for the following values of parameters: 

te[o,ti], ti = 2fcpi(fc), 

with the function pl{k) defined in Lemma 5.3 [8], 

S2 = -sgnyi, il) = ±K{k) - pl{k), 
and A: e (0,1) is the root of the equation 

2{p\ (fc) -E{pl{k), k) Vl - ky dn{p\ {k),k)) = \yi\, 

see Fig. 34. 




Figure 34: Optimal solutions for xi = 0, yi 7^ 0, 6*1 = 
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5.4.7 (a;i,yi) ^0, ^1 =7r 



Introduce the polar coordinates xi — picosxi, yi — pisinxi. There are two 
optimal solutions given by formulas for {xt,yt,Ot) for the case A G Ci in Sub- 
sec. 3.3 [8] for the following values of parameters: 

tG[0,fi], ti = 2K{k), 
and fee (0,1) is the root of the equation 

2{p\{k)-E{p\{k),k)^Jl-k^/dn{p\{k),k)) = pi, 
si = ±l, = siF(7r/2 - xi,fc), 

see Figs. 26, 27, 28. In the cases yi = and xi = we get respectively the cases 
considered in Subsubsecs. 5.4.4 and 5.4.5 

5.4.8 ^ 0, = 

There is a unique optimal solution given by formulas for {xt,yt,Ot) for the case 
A e C2 in Subsec. 3.3 [8] for the following values of parameters: 

S2 = -sgnyi, 

k e (0, 1) and p e (0,p}(A;)] are solutions to the system of equations 

s{sgnyi)2kfi{p,k)/dn{p,k) = Xi, s = ±1, 
2{p--E{p))Vl-kydn{p,k) = \yi\, 

and 

ie[0,ti], ti = 2kp, = sK{k) -p. 

5.5 Plots of caustic, cut locus, and sub-Riemannian spheres 

Here we collect 3-dimensional plots of some essential objects in the sub-Riemannian 
problem on SE(2). 

Figure 35 shows the sub-Riemannian caustic in the rectifying coordinates 

i?2, 0)- 

The cut locus in rectifying coordinates {R\,R2,6) is presented at Fig. 36, 
notice that here the horizontal planes = and 9 = 2tt should be identified. 
Global embedding of the cut locus to the solid torus (diffeomorphic image of 
the state space M = SE(2)) is shown at Fig. 37. 

Figures 38-46 present sub-Riemannian spheres 

Sn = {q€M\d{qo,q)=R} 
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Figure 35: Sub-Riemannian caustic 



of different radii R, where 

d{qo,qi) = mf{l{q{-)) \ q{-) trajectory of (1.1), 17(0) = qo, q{ti) ^ qi} 

is the sub-Riemannian distance — the cost function in the sub-Ricniannian 
problem (1.1)-(1.5). 

In this problem sub-Riemannian spheres can be of three different topological 
classes, li R £ (0,7r), then Sr is homeomorphic to the standard 2-dimensional 
Euclidean sphere S'^, see Fig. 40. For R = tt the sphere is homeomorphic to 
the sphere with its north pole N and south pole S identified: S-^ = S'^ /{N = 
5*}, see Fig. 43. And if i? > tt, then Sr is homeomorphic to the 2-dimensional 
torus, see Fig. 46. 

Figure 38 shows the sphere 8-^/2 in rectifying coordinates {Ri, R2,0). Fig- 
ure 39 represents the same sphere with a cut-out opening the singularities of 
the sphere: the sphere intersects itself at the local components of the cut lo- 
cus CutjQ^. Figure 40 shows embedding of the same sphere to the solid torus. 
Sub-Riemannian spheres of small radii resemble the well-known apple-shaped 
sub-Riemannian sphere in the Heisenberg group [18]. Although, there is a ma- 
jor difference: the sphere in the Heisenberg group has a one-parameter family 
of symmetries (rotations), but the sphere in SE(2) has only a discrete group of 
symmetries G = {Id, e^, . . . , e^} (reflections). 

Figures 41-43 represent similarly the sub-Riemannian sphere of the critical 
radius tt. In addition to self-intersections at the local components Cutj^^, the 
sphere 5^ has one self-intersection point at the global component Cutgiob- 
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Figure 36: Cut locus in rectifying coordinates 
{Ri,R2,6) 
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Figure 37: Cut locus: global view 



Figures 44-46 show similar images of the sphere of radius 37r/2. For R > w 
the sphere 5'^ has two topological segments of self-intersection points at Cutj^^. 
respectively, and a topological circle of self-intersection points at Cutgiob • 

Figures 47, 47 shows intersections of the spheres 5*^/2, S^r, with the 

half-spaces 9 < and ii!2 > respectively. 

Figure 49 shows self-intersections of the wavefront 

Wr = {Exp(A, R)\XeC} 

for R — IT. 

6 Conclusion 

The solution to the sub-Riemannian problem on SE(2) obtained in this paper 
and the previous one [8] is based on a detailed study of the action of the discrete 
group of symmetries of the exponential mapping. This techniques was already 
partially developed in the study of related optimal control problems (nilpotent 
sub-Riemannian problem with the growth vector (2,3,5) [11-14] and Euler's 
elastic problem [15, 16]). The sub-Riemannian problem on SE(2) is the first 
problem in this series, where a complete solution was obtained (local and global 
optimality, cut time and cut locus, optimal synthesis). We believe that our 
approach based on the study of symmetries will provide such complete results 
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Figure 38: Sub-Riemannian sphere Figure 39: Sub-Riemannian sphere 

with cut-out 




Sub-Riemannian sphere Figure 42: Sub-Riemannian s 

with cut-out 




Figure 44: Sub-Riemannian sphere Figure 45: Sub-Riemannian sphere 

5*3^/2 with cut-out 




Figure 47: Sub-Riemannian hemi-spheres S., 
^3^/2 for < 
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Figure 49: Wavefront W-^ with cut-out 



in other symmetric invariant problems, such as the nilpotent sub-Riemannian 
problem with the growth vector (2,3,5), the ball-plate problem [6], and others. 

The sub-Riemannian problem on the group of rototranslations SE(2) ap- 
peared recently as an important model in robotics [7] and vision [5,9]. We 
expect that our results can be applied to these domains. 
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